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Abstract 

"'■'■‘-^Thls  paper  presents  a  simplified  adaptive  tracking  filter  for  a  maneu¬ 
vering  target.  The  filter  Is  very  simple  and  easy  to  Implement.  No  prior 
knowledge  of  the  maneuvering  characteristics  Is  needed;  the  tracking  errors  are 
quite  small  Mhen  the  target  maneuvers.  While  the  target  does  not  maneuver,  the 
tracking  errors  are  a  bit  larger  than  others,  but  are  still  much  smaller  than 
measurement  errors.  This  method  can  be  used  either  with  linear  measurements  or 
nonlinear  measurements.  Simulation  results  for  various  target  maneuvers  are 
presented. 
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ON  A  SIMPLE  ADAPTIVE  TRACKING  FILTER 


I.  INTRODUCTION 

The  problem  of  tracking  a  maneuvering  target  has  been  discussed  by  many 
authors  [1]  -  [7].  For  most  of  these  filters,  the  maneuvering  characteristics 
of  the  target  are  assumed.  When  the  actual  target  maneuver  does  not  meet  the 
assumption,  the  tracking  accuracy  usually  Is  poor. 

Chan  et  al  [6],  [7]  proposed  a  tracking  scheme  with  Input  estimation.  In 
which  a  model  of  the  maneuvering  characteristics  Is  not  needed.  They  estimate 
the  acceleration  (maneuver)  Inputs  from  the  residuals  and  use  a  detector  for 
checking  the  magnitude  of  the  estimated  Input.  Only  when  the  magnitude  exceeds 
the  preset  threshold  level  are  the  estimates  used  to  update  the  Kalman  filter. 
However,  there  are  some  weaknesses  In  this  scheme.  The  first  one  Is  that  when 
the  target  manuevers  significantly ,  the  rms  errors  In  position  are  very  large. 
The  second  Is  that  when  the  target  performs  a  small  maneuver  which  lasts  some 
time,  the  acceleration  will  be  so  small  that  the  estimates  will  not  exceed  the 
threshold  level  and  will  not  update  the  Kalman  filter;  after  a  long  time  the 
errors  will  get  larger  and  larger.  Lastly,  the  detector  Is  somewhat 
compl Icated. 

A  simplified  adaptive  tracking  filter  Is  presented  here  which  uses  a  sim¬ 
plified  target  model.  It  Is  assumed  that  the  target  moves  In  a  straight  line 
with  constant  speed.  Also,  smoothed  residuals  are  utilized  to  control  the  gain 
calculation  of  the  Kalman  filter.  Then,  based  on  the  characteristics  of  the 
feedback  system,  the  filter  decreases  the  tracking  errors  automatically.  In 
this  method,  neither  the  characteristics  of  the  maneuver  nor  the  assumptions 
about  the  acceleration  1$  required.  The  algorithm  Is  very  simple  and  easy  to 
Implement.  When  the  target  performs  a  maneuver,  the  rms  value  of  position 
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errors  are  much  smaller  when  compared  with  Chan's  results  [61.  When  the  target 
does  not  maneuver,  the  errors  are  a  little  larger  than  Chan's  but  still  less 
than  the  measurement  errors.  This  method  also  can  be  generalized  to  the  case 
of  nonlinear  measurements  by  using  the  extended  Kalman  Filter  or  a  "bilinear" 
type  of  filter  [8],  [9]. 

II.  AN  ADAPTIVE  TRACKING  FILTER 

Consider  the  motion  of  a  point  mass  In  the  plane  with  constant  velocity  as 
the  target  model,  which  can  be  described  by  the  linear  difference  equations, 
1  «e. , 

Vi*fxh  +  »n-  »> 

where  XjJ  ■  [x(NT),  x(NT),  y(NT),  y(NT)]  with  prime  and  dot  designating  trans¬ 
pose  and  time  derivative,  respectively;  x(t),  y(t)  are  the  target  Cartesian 
Coordinates;  T  Is  sampling  time  of  measurements;  Wn  Is  a  zero-mean  Gaus¬ 
sian  random  vector  with  covariance  E{wnWnI  *  rN  (In  the  experiments.  It  Is  as¬ 
sumed  that  GUf|  *  0),  and 

~1  T  0  0_ 

0  10  0 

F  -  (2) 

0  0  1  T 

_0  0  0  1  _  . 

At  first,  assume  the  measurements  have  been  converted  to  rectangular  coor¬ 
dinates.  The  measurement  noise  Is  an  additive,  zero-mean,  white,  Gaussian  ran¬ 
dom  vector,  so  that  the  measurement  equations  are 


where 


„.[■  •  •  *1. 

(4) 

Lo  o  i  oj 

MvNf  -  o.  MVkI  -  RNaNK, 

(5) 

where  *ik  Is  the  Kronecker-del ta  function. 

The  estimates  of  the  state  at  the  time  NT  of  the  original 

Kalman  filter 

are  [10] 

^  *  FXN-1  +  '  HFXN-1>  *  FXN-1  +  XNSN* 

(6) 

Kn  «  FP^F'H'CHFP^F'H'  +  rn]_1. 

(7) 

PN  -  (I  -  tyOFP^F'd  -  knh)i  +  Wn  • 

(8) 

The  residuals  are 

S  ■  h  -  HFVl  ■  M(XN  -  FVl>  +  V 

(9) 

When  the  Initial  values  of  estimates  and  covariance  matrix  ($0f  Po)  are 
chosen.  Equations  (6}  -  (8)  can  be  used  recursively  to  calculate  the 
estimates. 


If  the  target  does  not  maneuver,  the  target  model  describes  accurately  the 
target  motion,  and  If  the  mean  of  the  Initial  error  equals  zero,  the  mean  of 
the  residuals  should  be  zero.  When  the  target  maneuvers,  the  target  model  will 
become  Inaccurate,  the  mean  of  the  residuals  will  no  longer  remain  zero ,  and 
tracking  errors  occur.  The  Kalman  filter  can  be  viewed  as  a  feedback  system. 
If  the  gain  Kg  has  appropriate  valdes,  the  errors  can  be  reduced  automat¬ 
ically.  But  when  GMu  ■  0,  Kr  and  Pr  will  tend  to  zero  so  that  the  resid¬ 
uals  will  no  longer  affect  the  estimates.  (If  GW^  f  0,  Kg  and  Pr 

eventually  will  tend  to  small  values,  and  the  residuals  cannot  significantly 

affect  the  estimates.)  The  tracking  errors  could  become  larger  and  larger,  and 
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eventually  tha  filter  will  fall  In  tracking.  In  other  words,  the  Kalman  filter 
"tracks"  the  erroneous  nod el  rather  than  the  maneuvering  target. 

Fro*  (9),  It  Is  seen  that  the  residuals  contain  two  terms.  One  Is  meas¬ 
urement  noise,  with  mean  equal  zero.  Another  Is  due  to  the  model  error  when 
the  target  maneuvers.  If  a  simplified  smoothing  Is  performed,  then  the 
smoothed  values  of  the  resludals  can  represent  In  some  sense  the  errors  pro¬ 
duced  by  target  maneuvering.  When  the  smoothed  values  exceed  some  threshold 
values,  the  adaptive  filter  will  reinitialize  the  previous  value  of  the  co- 
variance  Pn.i»  then  the  gain  K^  can  be  appropriately  adjusted  to  pro¬ 
vide  proper  feedback  and  the  estimated  errors  can  be  reduced  automatically. 
The  block  diagram  of  the  presented  adaptive  tracking  filter  is  shown  In  Fig¬ 
ure  1.  Here,  the  portion  below  the  dashed  line  corresponds  to  the  conventional 
Kalman-Bucy  filter. 

The  average  of  the  residuals  consisting  of  some  previous  time  points  and 
Including  the  present  time  point  as  the  simplified  smoothed  values  Is  chosen, 
so  that 

+  ^H-l  +  •••  +  ^  (10) 

Now,  the  gain  formula  Is  given  by 

Kn  «  FPF'H'CHFPF'H'  +  R^]"1,  (11) 


P  - 


|  po  when  ^,>1^1, 

I  PN-1  when  <  |  $L  |. 

i 

(I  -  KffH)FPF '(I  -  KjjH)'  ♦  KjjRjjKjJ  . 


(12) 

(13) 


When  the  values  \  and  Pg  are  chosen  appropriately  the  estimate  errors  will 
be  kept  within  a  reasonable  range. 


This  method  can  work  for  a  variety  of  target  maneuvers,  even  when  the  man¬ 
euver  Is  small  and  lasts  a  long  time.  The  weakness  of  this  method  might  be 
that  when  the  target  does  not  maneuver,  the  rms  values  of  estimate  errors  are  a 
little  larger  than  for  the  ordinary  Kalman-Bucy  filter,  but  they  still  will  be 
less  than  measurement  errors.  This  Is  because  the  two  factors  In  residuals 
Sf|  mix  together,  and  using  the  simplified  smoothing,  the  stochastic  compo¬ 
nents  cannot  be  eliminated.  So  sometimes  switching  occurs  even  when  the  target 
does  not  maneuver.  This  Is  the  cost  for  simplicity  and  for  keeping  small 
tracking  errors  when  the  target  maneuvers. 


III.  THE  ADAPTIVE  TRACKING  FILTER  WHEN  MEASUREMENTS  ARE  NONLINEAR 

We  can  generalize  this  method  to  nonlinear  measurements.  When  the  meas¬ 
urements  are  made  using  polar  coordinates 
b. 


ZN* 


-BFhO^), 


(14) 


where  b  1$  bearing,  r  Is  range, 

bN  ■  tan"1  ^  , 
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(16) 


The  extended  Kalman  filter  (EKF),  and  other  nonlinear  filters,  can  be  adapted 
to  this  scheme.  For  the  EKF,  the  measurement  matrix  Hr  Is  no  longer  con¬ 
stant.  With  the  target  model  In  Cartesian  Coordinates,  It  Is  a  function  of 
estimates. 
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Similar  to  Equations  (9),  (11),  and  (13),  the  other  formulae  are 


SN  *  ZN  -  BFhfFX^^)  , 

KN  *  FPP'HnCHnFPF'Hn  +  RN]_1  » 


(19) 

(20) 

(21) 

(22) 

(23) 


pn  -  C1  -  -  W  +  Wh  •  M 

In  this  case,  the  estimates  x,  y  can  he  used  to  estimate  bearing  and  range  as 
well  as  the  rms  errors  of  bearings  and  range. 

If  the  measurements  are  made  using  two  bearings  from  two  sensors  In 
separate  locations,  this  method  will  result  In  larger  tracking  errors.  Ihe 
problem  does  not  arise  from  the  filter  scheme  Itself,  but  from  the  sensitivity 
of  the  measurement  method. 

From  the  geometry,  exhibited  by  Figure  2,  It  can  be  seen  that,  even  when 
the  target  does  not  move,  with  the  two-bearing  measurements,  the  range  error 
may  be  very  large  even  If  measurement  errors  are  small.  Ihe  geometrical 
relationships  are  [11] 


b, )  -  cos(b,  +  b, ) 


s1n(b2  +  bj) 

Ab  *  b  -  ft,  (31) 

Ar  *  r  -  r.  (32) 

Here  Abj,  Ab2»  bj,  b2  are  measurement  errors  and  measurement  bearings 
respectively;  b,  r,  ft,  r  are  real  and  estimated  values  of  bearing  and  range 
respectively.  For  a  numerical  example.  If 

x  *  r  cos  b  «  2000  yds  ,  y  *  r  sin  b  «  4000  yds  ,  d  «  200  yds, 
then  r  -  4472.14  yds  ,  b  -  1.1071  rad.  (63.43°) 

bx  «  1.0680  rad  (61.19°)  ,  b2  »  1.1479  rad.  (65.77°). 

and  the  errors  shown  In  Table  I  result. 

Table  I.  Position  Error  Sensitivity  Relative  to 
Two-Sensor  Locations 


Abi  rad. 

Ab2  rad. 

+0.05 

♦0.05 

+0.05 

-0.05 

-0.05 

-0.05 

-0.05 

+0.05 

ft  '  rad. 

1.1572 

1.1078 

1.0542 

1.1039 

Ab  rad. 

-0.0501 

-0.0007 

0.0529 

0.0032 

ft  yds. 

4583.98 

11887.93 

4360.68 

1984.56 

ar  yds. 

-111.84 

-7415.79 

111.46 

2487.58 

w 


VI.  SIMULATION  RESULTS 

In  applying  the  simplified  adaptive  tracking  filter,  two  factors  need  to 
be  considered.  One  Is  the  number  of  residuals  M  used  to  get  the  simplified, 
smoothed  values.  It  Is  relevant  to  the  accuracy  of  the  smoothed  residuals.  If 
the  target  does  not  maneuver  and  the  measurement  noise  Is  white,  then  In  (9), 
the  mean  of  Sfl  equals  zero  and  the  standard  deviation  of  the  components  of 
the  Sf|  are  Inversely  proportional  to  the  square  root  of  M.  However,  a  large 
M  will  reduce  the  "weight"  of  the  recent  measurements.  So  generally  the  appro¬ 
priate  value  of  M  is  3-5.  In  this  simulation  M  =  3. 

The  second  factor  Is  how  to  choose  the  threshold  level  S^.  If  the 
threshold  level  Is  low,  tracking  errors  when  the  target  maneuvers  can  be  quite 
small.  However,  at  a  low  setting,  tracking  errors  when  the  target  does  not 
maneuver  will  tend  to  be  large.  This  Is  due  to  occasional  unexpected  rein¬ 
itializing.  In  practice  of  course,  the  filter  would  need  to  Ignore  certain  ex¬ 
traneous  "outlyers." 

For  a  fast-turn  maneuver  (see  Figure  3(a))  different  rms  errors  for  dif¬ 
ferent  Sl  are  shown  In  Figure  4  for  linear  measurements  and  In  Figure  5  for 
nonlinear  measurements.  The  standard  deviation  of  the  measurement  noise  Is  100 
yds.  (In  x,  y)  for  the  linear  observation  and  100  yds.  In  range  and  0.035  rad. 
In  bearing  for  the  nonlinear  observation.  The  results  are  about  as  expected. 
One  and  three  tenths  (1.3)  times  the  standard  deviation  of  measurement  noise  Is 
selected  for  S|_  as  a  compromise  between  transient  error  (due  to  maneuver)  and 
steady  error.  Of  course,  more  analysis  Is  necessary  to  "optimize"  this 
selection. 

As  a  comparison  with  the  method  of  Chan  et  al  [6],  [7]  almost  the  same 
target  maneuvering  and  data  Is  used.  There  Is  just  a  little  difference.  When 
the  target  maneuvers  It  Is  assumed  that  the  magnitude  of  the  target  velocity  Is 
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constant  and  the  direction  of  the  target  velocity  changes  uniformly  with  time 

rather  than  dlscontlnuously.  The  equations  of  the  adaptive  tracking  filter  are 

as  given  In  Section  II  with  data  T  ■  10s,  Sj_  »  130  yds  and 

[10000  5001 

I  »  N  *  1,  2,  3 . 100. 

500  10000J 


The  Initial  conditions  of  the  target  are  given  by  xg  «  1000  yds,  xo  *  0, 
yg  *  10000  yds,  yg  *  -15  yd/s.  The  mean  of  the  initial  errors  is  zero. 


and 


10,000 

0 

0 

0 


0 

100 

0 

0 


0  0 

0  0 

10,000  0 

0  100^ 


For  the  first  target  motion  (see  Figure  3, a),  the  target  mov^o  In  a 
straight  line  at  constant  speed  until  t  «  400s  (N  ■  40),  it  then  makes  a  fast 

turn  moving  with  angular  velocity  9*  -*/100  rad/s  until  after  50s  It  has  ex¬ 
ecuted  a  90°  turn.  It  then  continues  In  a  straight  line  at  constant  speed  on 

this  new  course.  The  second  motion  (Figure  3,b)  Is  much  like  the  first,  how- 

ever  the  turn  Is  slower  with  -w/400  rad/s.  In  this  case  the  turn  takes 
200s.  In  the  third  motion  (Figure  3,c),  the  target  carries  out  a  turn  Iden¬ 
tical  to  that  In  the  second  motion,  then  assumes  a  course  parallel  to  Its  orlg- 
Inal  one  by  performing  a  fast  turn  with  9  ■  w/100  rad/s.  In  the  fourth  motion 
(Figure  3,d),  the  target  performs  a  fast  circular  turn  (9  •  -w/100  rad/s). 
Completing  It  In  200s,  It  then  continues  on  this  original  course.  The  last 
motion  (Figure  3,d)  Is  a  very  slow  90°  turn  with  9  -  -w/1000  rad/s,  which  takes 
500  sec  to  complete.  In  all  of  these  motions,  the  maneuver  begins  at  t  *  400s 
(II  •  40). 


For  each  kind  of  target  motion,  50  samples  are  run  and  the  rms  errors  are 
computed.  The  standard  deviation  of  the  measurement  noise  Is  as  given  above 
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with  sample  rms  values  about  ±20%  about  this  value.  Figure  6  shows  the  rms 
tracking  errors  for  the  correspond ing  motions  with  linear  observations. 

For  nonl inear  measurements , 

[0.0012  0.1751 

N  =  1,  2 .  1000, 

0.175  10000 J 

Sli  *  0.045  rad  and  Sl2  *  130  yds. 

Again,  the  standard  deviation  of  the  measurement  noise  is  100  yds.  In  range  and 
0.035  rad.  In  bearing  with  the  sample  rms  values  approximately  ±20%  about  this 
sample  mean.  The  rms  tracking  errors  of  bearing  and  range  for  the  trajectories 
given  In  Figure  3  for  the  above  are  plotted  in  Figure  7. 

According  to  these  results,  the  adaptive  tracking  filter  ATF  is  very  ef¬ 
fective,  and  the  errors  are  significantly  less  than  by  the  method  of  Chan,  et 
al  [6],  [7].  A  rough  comparison  with  this  popular  method  is  made  In  Table  II. 


Table  II.  Comparison  of  Methods 


Max. 

RMS  Position  Error,  Yds. 

Motion 

ATF 

[6] 

[7] 

Figure  1(a) 

91-121 

180 

260-350 

Figure  1(b) 

82-88 

190 

290 

Figure  1(c) 

91-121 

215 

300 

Figure  1(d) 

121-122 

* 

360 

Figure  1(e) 

89-90 

* 

* 

♦Not  available 


Maximum  velocity  errors  by  the  proposed  method  are  approximately  10  to  50 
percent  less  than  the  method  of  Chan,  et  al  using  their  method  as  the  base  for 
comparison. 
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V.  CONCLUSION 


A  simple  adaptive  tracking  filter  has  been  presented  here.  For  each  meas¬ 
urement  sample,  the  filter  produces  the  residual  sample  and  does  very  simple 
smoothing.  In  turn,  the  smoothed  residuals  adapt  the  filter  gain.  This  method 
can  be  used  for  either  linear  measurements  or  nonlinear  measurements.  The  re¬ 
sulting  tracking  errors  are  small  for  all  cases  studied.  Also,  the  method  Is 
very  simple,  robust  and  involves  few  computations.  No  prior  knowledge  of  the 
maneuvering  characteristics  of  the  target  is  required.  If  it  is  known  how  fre¬ 
quently  the  target  maneuvers,  the  threshold  level  can  be  adjusted  to  optimize 
the  method's  performance.  If  there  is  an  operator  monitoring  the  smoothed 
residuals,  the  threshold  level  can  easily  be  adjusted  to  achieve  better 
tracking  performance. 

Since  a  class  of  "bilinear"  filters  has  shown  improved  performance  over 
extended  Kalman  filters  for  typical  nonmaneuvering  cases  and  the  above  non¬ 
linear  observations  [8]  and  [9],  It  Is  expected  that  the  planned  adaptation  of 
the  present  algorithm  to  the  "bilinear"  filter  will  yield  even  better  perfor¬ 
mance  than  that  shown  above. 
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